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Undirected Rigid Formations are Problematic 

S. Mou A. S. Morse M. A. Belabbas Z. Sun B. D. O. Anderson 


Abstract 

By an undirected rigid formation of mobile autonomous agents is meant a formation based on graph 
rigidity in which each pair of “neighboring” agents is responsible for maintaining a prescribed target 
distance between them. In a recent paper a systematic method was proposed for devising gradient control 
laws for asymptotically stabilizing a large class of rigid, undirected formations in two-dimensional space 
assuming all agents are described by kinematic point models. The aim of this paper is to explain what 
happens to such formations if neighboring agents have slightly different understandings of what the 
desired distance between them is supposed to be or equivalently if neighboring agents have differing 
estimates of what the actual distance between them is. In either case, what one would expect would be a 
gradual distortion of the formation from its target shape as discrepancies in desired or sensed distances 
increase. While this is observed for the gradient laws in question, something else quite unexpected 
happens at the same time. It is shown that for any rigidity-based, undirected formation of this type 
which is comprised of three or more agents, that if some neighboring agents have slightly different 
understandings of what the desired distances between them are suppose to be, then almost for certain, 
the trajectory of the resulting distorted but rigid formation will converge exponentially fast to a closed 
circular orbit in two-dimensional space which is traversed periodically at a constant angular speed. 
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I. Introduction 

The problem of coordinating a large network of mobile autonomous agents by means of 
distributed control has raised a number of issues concerned with the forming, maintenance and 
real-time modification of multi-agent networks of all types. One of the most natural and useful 
tasks along these lines is to organize a network of agents into an application-specific “formation” 
which might be used for such tasks as environmental monitoring, search, or simply moving the 
agents efficiently from one location to another. By a multi-agent formation is usually meant a 
collection of agents in real two or three dimensional space whose inter-agent distances are all 
essentially constant over time, at least under ideal conditions. One approach to maintaining such 
formations is based on the idea of “graph rigidity” [[TJ, [O - Rigid formations can be “directed” 
0-10, “undirected” 0, 0, or some combination of the two. The appeal of the rigidity based 
approach is that it has the potential for providing control laws which are totally distributed in 
that the only information which each agent needs to sense is the relative positions of its nearby 
neighbors. 

By an undirected rigid formation of mobile autonomous agents is meant a formation based on 
graph rigidity in which each pair of “neighboring” agents i and j are responsible for maintaining 
the prescribed target distance d,, :J between them. In 0 a systematic method was proposed for 
devising gradient control laws for asymptotically stabilizing a large class of rigid, undirected 
formations in two-dimensional space assuming all agents are described by ki nematic point 
models. This particular methodology is perhaps the most comprehensive currently in existence 
for maintaining formations based on graph rigidity. In 0 an effort was made to understand what 
happens to such formations if neighboring agents i and j have slightly different understandings of 
what the desired distance dij between them is supposed to be. The question is relevant because no 
two positioning controls can be expected to move agents to precisely specified positions because 
of inevitable imprecision in the physical comparators used to compute the positioning errors. The 
question is also relevant because it is mathematically equivalent to determining what happens if 
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neighboring agents i and j have differing estimates of what the actual distance between them 
is. In either case, what one might expect would be a gradual distortion of the formation from 
its target shape as discrepancies in desired or sensed distances increase. While this is observed 
for the gradient laws in question, something else quite unexpected happens at the same time. 
In particular it turns out for any rigidity-based, undirected formation of the type considered in 
|f6l which is comprised of three or more agents, that if some neighboring agents have slightly 
different understandings of what the desired distances between them are suppose to be, then 
almost for certain, the trajectory of the resulting distorted but rigid formation will converge 
exponentially fast to a closed circular orbit in IR 2 which is traversed periodically at a constant 
angular speed. In []8] this was shown to be so for the special case of a three agent triangular 
formation. The aim of this paper is to explain why this same phenomenon also occurs with any 
undirected rigid formation in the plane consisting of three or more agents. 


A. Organization 

This paper is organized as follows. In 1 1-B I we briefly summarize the concepts from graph 
rigidity theory which are used in this paper. In $11] we describe the undirected rigidity-based 
control law introduced in [[6]| and we develop a model, called the “overall system,” which exhibits 
the kind of mismatch error /x we intend to study. In - 0711 we develop and discuss in detail, a 
separate self - contained “error system” e = g(e, ft) whose existence is crucial to understanding 
the effect of mismatch errors. The error system can only be defined locally and its existence is 
not obvious. Theorem Q] states that overall system’s error e satisfies the error system’s dynamics 
along trajectories of the overall system which lie within a suitably defined open subset A. The 
theorem is proved in 1 111 - A I by appealing to the inverse function theorem. In 1 111- B I we prove 
that the “unperturbed” error system e = g(e, 0) is locally exponentially stable We then exploit 
the well know robustness of exponentially stable dynamical systems to prove in f llll-CI that even 
with a mismatch error, the error system remains locally exponentially stable provided the norm 
of the mismatch error // is sufficiently small. Finally in it 1 l-OI we show that if the overall system 
starts in a state within A at which the overall system’s error e is sufficiently close to the output 
e /; of the error system assuming the error system is in equilibrium, then the state of the overall 
system remains within A for all time and its error e converges exponentially fast to e M . 
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In 1H71 we develop a special 2x2 “square subsystem” whose behavior along trajectories of the 
overall system enables us to predict the behavior of the overall system. An especially important 
property of this subsystem is that it is linear along trajectories of the overall system for which 
the error system’s output is constant. 

In l|V]we turn to the analysis of the overall system which we carry out in two steps. First, in 
Section IV-AI we consider the situation when the overall system error e has already converged to 
e /; . In ! 1V-A 1 1 we develop conditions on the mismatch error // under which the state of the overall 
system will be nonconstant, even though e is constant. In TV-A2I we characterize the behavior of 
trajectories of the overall system assuming e is constant. The main result in the section, stated in 
Theorem |U is that for a large class of formations, the type of mismatch error we are considering 
will almost certainly cause the formation to rotate at a constant angular speed about a fixed point 
in two-dimension space, provided the norm of the mismatch error is sufficiently small. 

The second step in the analysis is carried out in Section 1 V-B 1 The main result of this paper, 
Theorem [5} states that if a formation starts out in a state in A at which its error e is equal to a 
value of the error systems’s output for which the error system’s state is in the domain of attraction 
of the error system’s equilibrium, then the formation’s state will converge exponentially fast to 
the state of a formation moving at constant angular speed in a circular orbit in the plane. 


B. Graph Rigidity 


The aim of this section is to briefly summarize the concepts from graph rigidity theory which 
will be used in this paper. By a framework in R 2 is meant a set of n > 3 points in the 
real plane with coordinate vectors x, L , % 6 n = {1,2,..., rz}, in R 2 together with a simple, 
undirected graph G with n vertices labeled 1,2,... ,n and on edges labeled 1,2,..., m. We 


denote such a framework by the pair {G, x} where x is the multi-point x = 


x[ 


A 


x r 


An important property of any framework is that its shape does not change under “translations” 
and “rotations.” To make precise what is meant by this let us agree to say that a translation 


of a multi-point x = 

A + y' A + y' ■ ■ ■ 


A 


x r 


A 


x'l 


x' 2 


x r 


y 


x' is a function of the form 

ou n 

where y is a vector in R 2 . Similarly, a rotation of a multi¬ 


point x is a function of the form 


X i X n 


XI 


(TxX ( Tx 2 y 


( Tx n y 


where 
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T : IR 2 —> IR 2 is a rotation matrix. The set of all such translations and rotations together with 
composition forms a transformation group which we denote by 0 ; this group is isomorphic 
to the special Euclidean group SE( 2). By the orbit of x e IR 2 ”, written 0.x is meant the set 
{ 7 ( 2 ) : 7 G 0}. Correspondingly, the orbit of a framework {G, x} is the set of all frameworks 
{G, y} for which y is in the orbit of x. By G’s edge function <p : R 2n —> IR m is meant the map 

r P I \ I I rp . _ rp . I I 2 I I rp . _ rp . I I 2 ... I I rp . _ rp . 

II ^1 ^JlW \\' L l2 ^3 2 II ll*^m ^3\ 

(■ ikijk ) is the /, th edge in G. A framework {G. x) is a realization of a non-negative vector 

v G !R m if <j){x) = v ; of course not every such vector is realizable. Two frameworks {G, x} and 
{G, ?/} in IR 2 are equivalent if they have the same edge lengths; i.e., if <f>{x) = 4>(y). {G, x} 
and {G,y} are congruent if for each pair of distinct labels i,j G n, j|x, — Xj\\ = || yi — yf\. It 
is important to recognize that while two formations {G, x} and {G, y} in the same orbit must 
be congruent, the converse is not necessarily true, even if both formations are “rigid.”. Roughly 
speaking, a framework is rigid if it is impossible to ‘deform’ it by moving its points slightly while 
holding all of its edge lengths constant. More precisely, a framework {G, x} in IR 2 is rigid if it 
is congruent to every equivalent framework {G, y} for which |,x — y\ is sufficiently small. The 
notion of a rigid framework goes back several hundred years and has names such as Maxwell, 
Cayley, and Euler associated with it. In addition to its use in the study of mechanical structures, 
rigidity has proved useful in molecular biology and in the formulation and solution of sensor 
network localization problems [13. Its application to formation control was originally proposed 
in |[2). Unfortunately, it is difficult to completely characterize a rigid framework because of many 
special cases which defy simple analytical descriptions. The situation improves if one restricts 
attention to frameworks for which the positions of the points are algebraically independent over 
the rationals. Such frameworks are called generic and their rigidity is completely characterized 
by the so-called rigidity matrix % n x 2 n(%) = The rigidity matrix appears in the expression 
for the derivative of the edge function f{x{t)) along smooth trajectories x(t), t > 0 ; i.e., 
4>(x(t)) = 2 ${(x(t))x(t). It is known that the kernel of fR(x) must be a subspace of dimension 
of at least 3 0]; equivalently, for all x, rank 9\(x) < 2n — 3. A framework {G, x} is said to be 
infinitesimally rigid if rank 9f(.x) = 2n — 3. Infinitesimally rigid frameworks are known to be 
rigid CO, iflOl . but examples show that the converse is not necessarily true. However, generic 
frameworks are rigid if and only if they are infinitesimally rigid CD- Any graph G for which 
there exists a multi-point x for which (G, x} is a generically rigid framework, is called a rigid 


, where for k G m = {1,2,..., m}, 
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graph. Such graphs are completely characterized by Laman’s Theorem IfTTI which provides a 
combinatoric test for graph rigidity. It is obvious that if {G, x} is infinitesimally rigid, then so 
is any other framework in the same orbit. 

An infinitesimally rigid framework is minimally infinitesimally rigid if it is infinitesimally 
rigid and if the removal of an edge in the framework causes the framework to lose rigidity. It 
is known that an infinitesimally rigid framework is minimally infinitesimally rigid if and only if 
m = 2n— 3 An infinitesimally rigid framework {G, x} can be “reduced” to a minimally 

infinitesimally rigid framework {G, x}, with G a spanning subgraph of G, by simply removing 
“redundant” edges from G. Equivalently, {G, x} can be reduced to a minimally infinitesimally 
rigid framework {G, x\ by deleting the linearly dependent rows from the rigidity matrix 91 (x), 
and then deleting the corresponding edges from G to obtain G. The rigidity matrix of {G, x}, 
namely 9l(x), is related to the 91(x) by an equation of the form 91(x) = PD\(x) for a suitably 
defined matrix P of ones and zeros. 

In this paper we will call a framework a formation. We will deal exclusively with formations 
which are infinitesimally rigid. 


II. Undirected Formations 

We consider a formation in the plane consisting of n > 3 mobile autonomous agents {eg, 
robots} labeled 1,2,... ,n. We assume the desired formation is specified in part, by a graph G 
with n vertices labeled 1,2 ,... ,n and m edges labeled 1,2 ,... ,m. We write kij for the label of 
that edge which connects adjacent vertices i and j. Thus k t] = kji. We call agent j a neighbor 
of agent i if vertex j is adjacent to vertex i and we write A} for the labels of agent ids neighbors. 

We assume that the desired target distance between agent i and neighbor j is d tJ where dij 
is a positive number. We assume that agent i is tasked with the job of maintaining the specified 
target distances to each of its neighbors. However unlike [[61 we do not assume that the target 
distances d tl and dji are necessarily equal. Instead we assume that d Tl — d,, :j < Bk i:i were 3k tJ is 
a small nonnegative number bounding the discrepancy in the two agents understanding of what 
the desired distance between them is suppose to be. We assume that in the unperturbed case 
when there is no discrepancy between d l;i and dji, these distances are realizable by a specific 
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set of points in the plane with coordinate vectors y l5 y 2 ,..., y n such that at the multi-point 
r i f 


y = 


V\ V 2 • • • Vn 


, the resulting formation {G, y} is infinitesimally rigid. We call {G, y} as 


well as all formations in its orbit, target formations. 


In this paper we will assume that any formation {G,./;} which is equivalent to target formation 
{G, y}, is infinitesimally rigid. While this is not necessarily true for every possible set of 
realizable target distances, it is true generically, for almost every such set. This is a consequence 
of Theorem 5.5 of IIT31 . An implication of this assumption is that the set of all formations 
equivalent to target formation {G, y} is equal to the finite union of a set of disjoint orbits lfl4l . 
We will assume that there are n Q > 0 such orbits, that {G, y '} is a representative of orbit i. and 
that {Gjy 1 } is the target formation {G,y}. 

We assume that agent %'s motion is described in global coordinates by the simple kinematic 
point model 

Xi = Ui, i G n. (1) 


We further assume that for i G n, agent i can measure the relative position x :j — x, of each of its 
neighbors j G Af t . The aim of the formation control problem posed in [{6l is to devise individual 


agent controls which, with x = 


x\ 


x 2 


X ri 


, will cause the resulting formation {G, x} to 


approach a target formation and come to rest as t —> oo. The control law for agent i proposed 
in |6]| to accomplish this is 


Ui = ^(Xj - Xi)(\\xj - Xi \\ 2 - dij). 
j&K 

Application of such controls to the agent models ([B yields the equations 


Xi=^2(xj - Xi)(\\xj - Xi\\ 2 - dfj), ie n (2) 

jeMi 

Our aim is to express these equations in state space form. To do this it is convenient to assume 
that each edge in G is “oriented” with a specific direction, one end of the edge being its ‘head’ 
and the other being its ‘tail.’ To proceed, let us write H mxn for that matrix whose kith entry is 
h ki = 1 if vertex i is the head of oriented edge /.:, h kt = —1 if vertex i is the tail of oriented 
edge k and h k i = 0 otherwise. Thus H is a matrix of Is, —Is and Os with exactly one 1 and 
one —1 in each row. Note that H is the transpose of the incidence matrix of the oriented graph 
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G; because G is connected, the rank of H is n — i m. Next define for each edge k i3 . 


Z k i:i = Xij{ x i ~ Xj) 


(3) 


where Xij = 1 if i is the head of edge k l3 or Xij = —1 if i is the tail of edge k tJ . The definition 
of H implies that 

z = Hx (4) 


A 


A 


where z = 
Kronecker product. 



H 


2mx2n 


H <g) I 2x2 , hx 2 is the 2 x 2 identity and ® is the 


Next define d kij = d,j and /x kij = df- — d'j, for all adjacent vertex pairs (i,j) for which % is 
the head of edge k l3 ; clearly 

d l - aIld d % = d 'h :i ~ k'kij 

for all such pairs. Let e k : !R m — > R denote the kth error function 

e k (z) = \\z k \\ 2 - d\, ke m. (5) 

Write A/‘ + for the set of all j £ A/} for which vertex i is a head of oriented edge k tJ . Let J\f~ 
denote the complement of Mf in A'j. With the z kij and z as defined in © and © respectively, 
the system of equations given in © can be written as 

Xi = ~ Y z kij e kij (z) + Y z kij(e kij (z) + n kij ), i £ n. ( 6 ) 

j&M+ j&M- 

These equations in turn can be written compactly in the form 


x = — R'(z)e(z) + S\z)n 


(7) 


where // is the mismatch error /i = 


, e(z) = 


ei(z) e 2 (z) 


e m (z) 


Ml M 2 • • • Mm 

7?mx2n('2') 77 (z)Ff, S < mx2n(") D (^)</, D 2rnxm (z') diclgOnal{ Z \, Z 2 , ■ ■ ■ , Z m } , and J 2 mx2n 

is what results when the negative elements in — if are replaced by zeros. It is easy to verify that 
R(z)\ z= fj x is the rigidity matrix 9f(x) for the formation {G, x} [©. Note that because of ©, 
© is a smooth self-contained dynamical system of the form x = f(x, m)- We shall refer to © 
{with z = Hx} as the overall system. 


Triangle Example: For the triangle shown in Figure Q] 

T 2[[i]](c[[i]] T /^[[i]])j 7 £ {1,2,3} 
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where [1] = 2, [2] = 3, [3] = 1 and for i e {1,2,3}, Zi = ay — and e* = \\zi\\ 2 — d 2 . 

Application of these perturbed controls to (OQ) then yields the equations 

ii = —z^ + Z[[i]]e[[i]] + Z[\i]]/J,[[i]], i e {1,2,3}. (8) 



Fig. 1. Undirected Triangular Formation 


III. Error System 

Our aim is to study the geometry of the overall system. Towards this end, first note that 

z = —HR'(z)e(z) + HS'(z)fi (9) 

because of © and ©. This equation and the definitions of the e/,. in © enable one to write 

e = —2R(z)R! (z)e + 2R(z)S'(z)y. (10) 

If the target formation {G, y} is only infinitesimally rigid but not minimally infinitesimally 
rigid there are further constraints imposed on e stemming from the fact there are geometric 
dependencies between its components. Because of this, along trajectories where {G, x(f)} is 
infinitesimally rigid, e evolves in a closed proper subset S C !R m containing 0. We now explain 
what these dependencies are and in the process define S. 

Set m = 2n— 3, the rank of the rigidity matrix of {G, y}. Suppose that {G, y} is not minimally 
infinitesimally rigid in which case m > rh. Let G be any spanning subgraph of G for which 
{G, y} is minimally infinitesimally rigid. Write e for the sub-vector of e whose rh entries are 
those entries in e corresponding to the edges in G. Similarly, write e for those entries in e 
corresponding to the m — rh edges in G which have been deleted to form G. Let P and P be 
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those matrices for which e = Pe and e = Pe respectively. Note that 
matrix; therefore PP' = I, PP' = I, PP' = 0 , and e = P'e + P'e. 




is a permutation 


Recall that each entry e s in e is, by definition, a function of the form (x t — Xj)'(xi — Xj) — d? s 
where (i,j) is the sth edge in G. The following proposition implies that each such e s can be 
expressed as a smooth function of e at points a; in a suitably defined open subset of ]R 2n where 
(G, x} is minimally infinitesimally rigid. 

Proposition 1: Let {G, y} be a target formation. There exists an open subset A C !R 2n 
containing y for which the following statements are true. For each four distinct integers i, j. k . I 
in n, there exists a smooth function r]ijki : Pe(IIA) — > 1R for which 

{Xi - Xj)'(x k - Xi) = rj ijk i(Pe(Hx)), x e A. (11) 

Moreover, A is invariant under the action of (5 and for each x G A, the reduced formation 
{G, x}, is minimally infinitesimally rigid. 


The proof of this proposition will be given at the end of this section. 

In view of Proposition Q] there must be a smooth function i/j : Pe(HA) —> suc h that 

e(Hx) = ij}{Pe{Hx)), x G A. Observe that -0(0) = 0 because Pe(Hy) = 'ip(Pe(Hy)) and 
e(Hy) = 0. 


Note that 

e(Hx) = P'e(Hx) + P'^(e{Hx)), xeA ( 12 ) 

because e = P'e + P'e. Moreover, since PP' = 0, PP' = I and e = Pe, it must be true that 
for x E A, Pe(Hx) = il>(Pe(Hx)). In other words, for such values of x, e(Hx) takes values in 
the subset 

£ = {e:Pe- tfj{Pe) = 0 , e e e(HA)}. 

It is easy to see that 0 e £. 

We claim that for values of x(t) G A, the reduced error e = Pe satisfies the differential 
equation 

g = -2 RR'e - 2 RR'F\e)i/j{e) + 2 RS'p (13) 
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where R(Hx) is the rigidity matrix of the minimally infinitesimally rigid formation (G, x} and 

F(e) = ^(e). (14) 

oe 

To understand why this is so, note first that (fTOl) and (fl2l) imply that 

g = —2PRR' (P'e + P'ip{e)) + 2 PRS'fi. (15) 

By definition, the rigidity matrix of {G, x} is R(Hx) = (Hx). Clearly P\-j^e{Hx) = 

PR(Hx) so R = PR. From this and (fl5l) it follows that 

g = -2RR'e - 2R{PR)'ip{e) + 2 RS'fi (16) 

But by definition, R(Hx) = \-^e(Hx). From this and (fl2l) it follows that R = P'R + P'FR 
where F is given by (fl4l) . Thus PR = FR which justifies the claim that (fl3l) holds. 

The preceding easily extends to the case when (G, y } itself is minimally infinitesimally rigid. 
In this case, g = e and (fl2l) holds with P = I, P = 0, and ip = 0, while £ = !R m . 

The proof of Proposition Q] relies on several geometric facts. The ones we need are encom¬ 
passed by the following two lemmas. 

Lemma 1: Let Vi,V 2 ,v 3 ,v 4 be four vectors in DC where s is any fixed positive integer. Then 

(t>! - v 2 )'(v 3 - v 4 ) = ^{||u 3 - v 2 \\ + IK - V 4 \\ 2 - ||t>3 - Will 2 -\\v 2 - W 4 || 2 }. (17) 


Proof of Lemma [Q Note that 

(wi - v 2 )\v 3 - v 4 ) = (wi - v 3 )\v 3 - v 4 ) - (v 2 - V 3 )'(v 3 - v 4 ) 
because v 4 — v 2 = (v 4 — v 3 ) — ( v 2 — v 3 ). But 

(wi - v 3 )\v 3 - v 4 ) = ~{| |wi - w 4 || 2 - 11W,3 - Will 2 — 11W 3 — w 4 || 2 } 


( 18 ) 


and 


(w 2 - w 3 )'(w 3 - w 4 ) = -{||w 2 - w 4 || 2 - ||w 3 - w 2 || 2 - ||w 3 - w 4 || 2 }. 


From these identities and (fl 8 l) it follows that ([T7T) is true. 
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In the sequel we will show that for any x = 


X i X n 


X' 


in a suitably defined open 


set of multi-points x for which {G, x} is minimally infinitesimally rigid, it is possible to express 
the squared distances between each pair of points ay, ay in terms of the reduced error Pe(Hx). 
Since infinitesimal rigidity demands among other things that for at least one pair of points p 
and q, x p f x q , nothing will be lost by excluding from consideration at the outset, values of 
x for which x p = x q . For simplicity we will assume the vertices are labeled so that x\ f x 2 . 
Accordingly, let X denote the set of all x £ R 2 ” for which ay f x 2 and write 5 : X —> R 
for the squared distance function 


n(n — 1 ) 
2 


X 


\\xi-x 2 \\ 2 ||xi-x 3 | 


An— 1 


To avoid unnecessarily cluttered formulas in the statements and proofs of some of the lemmas 
which follow, we will make use of the function p : X —> R m defined by x i— > Pe(Hx). Note 
that p{x) and Pe(Hx) have the same value at every point x £ X. although their domains are 
different; consequently they are different functions. Note also that for any transformation 7 in 
the restriction of © to X, p o 7 = p. Thus for any subset W C X, p _ 1 (W) is 0 invariant. 


Lemma 2: Let {G, y} be a target formation. There is an open set A Cl X containing y and a 


n(n— 1 ) 


smooth function / : Pe(HA) —> R 2 for which 


5(x) = f(Pe(Hx)), x G A. 


(19) 


Moreover, A is invariant under the action of 0 and for all x G A, the reduced formation {G, x} 
is minimally infinitesimally rigid. 


Proof of Lemma [2} For each nonzero vector q 
matrix 


Qi 



in R 2 , let T q denote the rotation 


T 

-L n 



—Qi 

Q2 


Note that T q q = 
R 2 - 0. Next, wit 

x = 


0 1141 


and that the function q 


1 m = 2n - 3, write n : X —> R" 


x\ 


x 2 


X r 


£ X, the vector 


T q is well-defined and smooth on 
for that function which assigns to 


* 2 -aa|| (T( X3 _ xi) (x 3 - xi))' 





March 4, 2015 


DRAFT 

















IEEE TRANSACTIONS ON AUTOMATIC CONTROL, ACCEPTED. 


13 


in IR m . Note that 7 r is well defined and smooth. Clearly 

I \xj - xi|| 2 = ||T( X2 _ Xl) (a: J - - £i)|| 2 , j E {3,4, 

and 


\Xj 37 1 | 11 r ^-'{x2—x\) i^j •t'l) r ^-'{x2—xi •t'l)|| i 


i E {2,3,...,n}, j E {i + 1,, i + 2,..., n}. 


Thus any entry in 5(x) is a polynomial function of entries in tt(;/;). Therefore there is a polynomial 

— ~ n(n — 1 ) — 

function 5 : 1R " 1 —> IR 5 such that 5 = 5 o n. Since same reasoning applies to the error map 
p, there must also be a polynomial function p : IR m —y IR m such that p = po n. 


Note that the derivative of \p at y, namely iMfi | x=y is the rigidity matrix of reduced for¬ 


mation {G, ?/}. Since {G, y} is minimally infinitesimally rigid, rank 


dp(x) | 


dx i x =v 


= m. Meanwhile 


9p(x) 


dp(g) 


dn(x) | 


dx \ x =y d q I q=n(y) ax \ x =v 


Therefore 


rank 


9p(q ) | 

dq 


\q=n(,y) — 


> m. 


( 20 ) 


But 


9p{q) I 

dq I 


- l= 7 r (y) is an m x m matrix so it must be nonsingular. Thus by the inverse function 
theorem, there is an open subset W C !R m containing n(y) for which p has a smooth inverse 
6 : p(W) W. Therefore 9(p o n(x)) = tt(x) for tt(x) G W or equivalently 


9{p{x)) = 7r(x), X G 7T ^W). (21) 

Note that the non-singularity of at q — n(y) implies that W can be chosen so that (1271) 
holds and at the same time, so that is nonsingular on W. Let W be so defined. 

Set A = 7 r - 1 (W) and note that y E A because 7 r(y) e W. From (CHT) and the fact that 
5 = 5 o 7 r there follows 

5(x) = 5 o 9 o p(x), x E A. 

Since p(x) = Pe(Hx), x E A, (fl9l) holds with / = So p~ x . 


The definition of 7r implies that tt o a for all transformations 7 in the restriction of © to X. 
This and the definition of A imply that A is (15 - invariant. 
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Non-singularity of the matrix on W implies non-singularity of q =n( x ) f° r x E A. 
Since the rigidity matrix of {G,x} at x E A can be written as ^^-\ q=7r (x)^r-, to establish 
minimal infinitesimal rigidity of {G, x} on A, it is enough to show that for each x E A 

di t(x) „ 

rank —-— > m. (22) 

ox 


By direct calculation 


dn(x) 

dx 


A 


1x4 


CVon- 


(2n—4) x4 -S(2n-4)x(2n-4) 


where A = 


i 


\\xl-X2\ 


X, 


Xr, 


Xr, 


Xl 


, B = block diagonal {T X2 - Xl ,T X2 _ Xl } and C is 


some suitable defined matrix. Moreover A is nonzero because x E A and B is nonsingular 
because T x2 _ XI is a rotation matrix. Thus the rows of are linearly independent for x E A. 
It follows that (l22l) holds for all x E A and thus {G, x} is minimally infinitesimally rigid for 
all such x ■ 


Proof of Proposition Q} In view of Lemma [2l there exists a © - invariant, open set A C 1R 2 " 
containing y and a smooth function / for which (fl9l) holds. Let be distinct integers in 

n. In view of Lemma HI to establish the correctness of statement (fTTl) it is enough to prove 
the existence of rjijki for the case when k — i and j = l. But the existence of rjijij follows at 
once from (fl9l) and the definition of the squared distance function 5. The minimal infinitesimally 
rigidity of {G, x} for x E A, follows from Lemma O ■ 


A. Error System Definition 

A key step in the analysis of the gradient law proposed in fl6|] is to show that along trajectories 
of the overall system (7]). the reduced error vector e satisfies a self-contained differential equation 
of the form e = g(e, /i) where g is a smooth function of just e and g and not z. As we will 
see, this can be shown to be true when x(t) takes values in the open subset A mentioned in the 
statement of Proposition Q] The precise technical result is as follows. 

Theorem 1: Let {G, y) be a target formation and let A be the open subset of IR 2 " mentioned 
in the statement of Proposition |U There exists a smooth function g : Pe(HA) x !R m —> ]R m for 
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which 

g(e,n) = —2 RR'e — 2 RR'F\e)ip(e) + 2 RS'p, x E A (23) 

where e is the reduced error e = Pe(Hx) and F is given by (fT4l) . Moreover, if x(t) is a solution 
to the overall system ([7]) for which x(t) e A on some time interval [t 0 , /, |), then on the same 
time interval, the reduced error vector e = Pe(Hx(t )) satisfies the self-contained differential 
equation 

e = 0(e>AO- (24) 


Although A and g are defined for a specific target formation {G, y}, it is not difficult to see that 
both are the same for all formations which are in the same orbit as {G, y}. In the sequel we 
refer to (l24l) as the error system and we say that A is the ambient space on which it is valid. 


Proof of Theorem[D The structures previously defined matrices D(z) = diagonal {z t . z 2 , ■ ■ ■, z m j, 
R(z ) = D'(z)H, S(z) = D'(z)J R(z ) = PR(z ) imply that the entries of both R(z)R'(z ) and 

i f r 

R(z)S'(z) are linear functions of the entries of the Gramian z\ z 2 ■ ■ ■ z m z\ z 2 ■ ■ ■ z m ■ 

In view of © it is therefore clear that the entries of R(z)R'(z)\ z= p x and R(z)S'(z)\ z= p x can 
be written as a linear combination of inner product terms of the form (xi — Xj)'(xk — x,j) for 
i,jAJ ^ n - From this and Proposition Q] it is clear that there exists an open subset A C IR 2n 
containing y for which each entry in R{z)R\z)\ z= p x and R(z)S'(z)\ z= p x can be written as a 
smooth function of Pe(Hx ) on Pe(HA). The existence of a smooth function for which (1231) 
holds follows at once. The second statement of the theorem is an immediate consequence is this 
and (fl3l) . ■. 


B. Exponential Stability of the Unperturbed Error System 

In this section we shall study the stability of the error system for the special case when 
/i = 0. It is clear from (1231) that in this case, the zero state e = 0 is an equilibrium state of the 
unperturbed error system. The follow theorem states that this is in fact an exponentially stable 
equilibrium. 
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Theorem 2: The equilibrium state e = 0 of the unperturbed error system e = g(e, 0) is locally 
exponentially stable. 

Proof of Theorem 12 First suppose that the target formation {G, y} is not minimally in¬ 
finitesimally rigid, and that the reduced formation {G, y} is. To prove that e = 0 is a locally 
exponentially stable equilibrium it is enough to show that the linearization of e = g(e, 0) at 0 is 
exponentially stable lfl6ll . As noted in the proof of TheoremU] the matrix R(z)R'(z)\ z= f Ix can be 
written as a smooth function of Pe(Hx) on Pe(HA) Thus the function Q : Pe{HA) —> IR mxm 
for which Q(Pe(Hx )) = P(Hx)P'(Hx) is well defined, smooth, and positive semi-definite 
on Pe(fdA). We claim that Q(0) is nonsingular and thus positive definite. To understand 
why this is so, recall that for any vector x G IR 2n , P(z)\ z= f Ix is the rigidity matrix of the 
formation {G, x}. In addition, y G A so by Proposition [H the formation {G, y} is minimally in¬ 
finitesimally rigid. Therefore rank R(Hy ) = fa. Hence R(IIy)R'(IIy) is nonsingular. Moreover 
Q(0) = R(Hy)R'(Hy) since e(Hy ) = 0. Therefore Q(0) is nonsingular as claimed. 

From (1231) . the definition of Q, and the definition of F in (fl4l) . it is clear that for e G Pe(HA) 

9g( ^ Q) = -2 Q(I + F'F + F'A) - 2 (jjpj (e + F». 

Therefore 

=-2Q(0)(/ + F'(0)F(0)). (25) 

e=0 

But —2Q(0)(J + F'(0)F(0)) is similar to — 2TQ(0)T' where T is any nonsingular matrix such 
that T'T = I + F'(0)F(0). Since —2TQ(0)T' is negative definite, it is a stability matrix. Hence 
—2Q(0)(/ + F / (0)F(0)) is a stability matrix. Therefore the linearization of e = g(e, 0) at e = 0 is 
exponentially stable. Therefore e = 0 is an exponentially stable equilibrium of the error system 

e = g(e, 0). 

Now suppose that {G, y} itself is minimally infinitesimally rigid. In this case the same 
argument just used applies except that in this case, the right side of (1251) is just —2Q(0). ■ 

C. Exponential Stability of the Perturbed Error System 

As is well known, a critically important property of exponential stability is robustness. We 
now explain exactly what this means for the error system under consideration. First suppose that 


dg(e, 0 ) 
de 
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the target formation {G, y} is not minimally infinitesimally rigid, and that the reduced formation 

{G,y} is. 


1) 

2 ) 

3) 


4) 


As was just shown in the proof of Theorem [2] (l25l) holds and — 2Q(0)(I + F / (0)F(0)) is 
a stability matrix. 

Clearly — 2<5(0)(/+F'(0)F(0)) is nonsingular. Therefore by the implicit function theorem, 
there exists an open neighborhood Ai 0 C lR m centered at 0 and a vector e t , which is a 
smooth function of y on M 0 such that e 0 = 0 and g(e fl , y) = 0 for /i6 A4 0 . 

The Jacobian matrix 


J(y) = 


dg{e,y) , 

(k 


in continuous on M. Q and equals the stability matrix —2<3(0)(/ + i rv (0)F(0)) at y = 0. For 
any y in any sufficiently small open neighborhood M C _M 0 about 0, ./(//) is a stability 
matrix. 

Stability of J(y) is equivalent to exponential stability of the equilibrium state e t , of the 
system e = g(e , /i). 


Of course the same arguments apply, with minor modification, to the case when {G, y} itself is 
minimally infinitesimally rigid. We summarize: 

Corollary 1: On any sufficiently small open neighborhood M. C lR m about y = 0, there is a 
smooth function // i—> e /; such that e 0 = 0 and for each /i e M, e /; is an exponentially stable 
equilibrium state of the error system e = g(e,y). 

Prompted by (fl2l) . we define the equilibrium output of the error system e = gie, //) to be 

= P , e At + P /, 0( e M)- noted just below the statement of PropositionQ] ^ is a smooth function 
and -0(0) = 0. Thus, like the error system’s equilibrium state, is a smooth function of y and 
c 0 = 0. 


D. Exponential Convergence 

At this point we have shown that for y G M, the equilibrium of the error system is 
locally exponentially stable. We have also shown that along any trajectory of the overall system 
for which x(t) e A, the reduced error e satisfies the error equation (l24l) and the overall error 
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satisfies (fT2l) . It remains to be shown that if x starts out at a value in some suitably defined 
open subset of A for which Pe(Hx) is within the domain of attraction of the error system’s 
equilibrium e M , then x will remain within the subset A for all time and consequently e and e 
and will converge exponentially fast to e /; and e M = P'e^ + -P'i/Kg) respectively. This is the 
subject of Theorem [3] below. 

Before stating the theorem we want to emphasize that just because the reduced error might 
start out at a value Pe(Hx( 0)) which is close to or even equal to e M , there is no guarantee 
that x(0) will be in A. In fact the only situation when Pe(Hx(0)) = 0 would imply x 6 A 
is when the target formation is globally rigid Ifl3l . The complexity of this entire problem can 
be traced to this point. The problem being addressed here cannot be treated as a standard local 
stability problem in error space. 

Theorem 3: Let {G, y} be a target formation and let A be the opened set referred to in the 
statement of Proposition [U For each value of //. in any sufficiently small open neighborhood A4 
in ]R m about // = 0, and each initial state x(0) e A for which the error e(Hx(0)) is sufficiently 
close to the equilibrium output of the error system e = g(e,n), the following statements are 
true: 

1) The trajectory of the overall system starting at x(0) exists for all time and lies in A. 

2) The error e = e(Hx(t )) converges exponentially fast to e M . 

To prove this theorem, we will need the following lemmas. 

Lemma 3: Let {G ,y} be a target formation and let A be the opened set referred to in the 
statements of Lemma [2] and Proposition [Q There exists an open ball B 0 C IR m centered at 0 
and an open set C C IR 2re such that C and the closure of A are disjoint and 

p-\B 0 )cAuC. (26) 


Proof of Lemma |3] Let {G, y}, {G, y 2 },..., {G, y n °} be representative formations within the 
n 0 disjoint orbits whose union is the set of all formations equivalent to {G, y}. By assumption, 
each of these formations is infinitesimally rigid. Thus by the same reasoning used to establish the 
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existence of W and 9 in the proof of Lemma [H one can conclude that for each i G {2,3 ,,n Q }, 
there is an open subset W t C IR m containing Tr(y') and an inverse function 9, : piW,) —>■ W,. 
Since the 7i(y l ) and tt( y) are distinct points , the W) can be assumed to have been chosen small 
enough so that all are disjoint with the closure of W. Thus the set S = U”7 2 W, and the closure 
of W are disjoint. 

Note that the restriction of p to W is 9~ l which in turn is a homeomorphism. Thus the 
restriction of p to W is an open function which implies that p(W) is an opened set. By similar 
reasoning, each p(Wj) is also an opened set as is the intersection n ;( z no y(WV) where W) = W. 
Moreover 0 is in this intersection because n(y) G Wi, n(y l ) G Wi, i G {2,3,... ,n a } and p 
maps each of these points into 0. 

Let T be the complement of WU5 in R m . Note that p{T) cannot contain the origin because 
the only points in the domain of p which map into 0 are in W U S. This implies that the set 

Bo = n p( w <) - mt> n p| p(w,) 

ien 0 iG no 

contains 0. We claim that £> 0 is opened. Since rij eno p(Wi) is opened, to establish this, it is 
enough to show that T D rij eno p(W,;) is closed. This in turn will be true if p(T) is closed. But 
this is so because T is closed and because p is a weakly coercive, polynomial function mapping 
one finite dimensional vector space into another iflTl . 

We claim that 

p~\B 0 ) CWUS. (27) 

To show that this is so, pick q G p~ 1 (B a ) in which case p(q) G B a . But q C IR m and ]R m = 
WU5UT so g G W U 5 U T. But q cannot be in T because p(q) G B 0 and B a and p{T) are 
disjoint. Thus p(q) G W U S so q G p -1 (W U S). Therefore (l27l) is true. 

We claim that (l26l) holds with C = i r —1 («S) and that with this choice, C and the closure of A 
are disjoint. To establish (l26l) . pick x G p -1 (£> 0 ); then n(x) G p _1 (S 0 ) because p = p o 7r. In 
view of (l27l) . n(x) G W U S. But A = i r _1 (W) and C = n _1 (5) so x G A U C. Therefore (l26l) 
is true. 

To complete the proof we need to show that C and the closure of A are disjoint. Note that 
because 7r is continuous, A C i r -1 (>V) where A and TV are the closures of A and W respectively. 
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Then A D C C n 1 (W) (T i r 1 (<S) C tt 1 (W (T S). But W and S are disjoint so A and C must 
be disjoint as well. ■ 


Lemma 4: Let {G, y} be a target formation and let A be the opened set referred to in the 
statement of Lemma [2] and Proposition HJ For any sufficiently small open ball B C IR" ! centered 
at 0, 


B C Pe(HA) 


(28) 


and 

closure (As) C A (29) 


where 

Ab = {x : Pe(Hx) G B, x G A}. (30) 


Proof of Lemma 0J Since p — p o tt, p[A) = p{tt(A)). Moreover A = 7r _1 (W); but n is 
surjective so tt{A) = W. As noted in the proof of Lemma [3l the restriction of p to W is an 
open map. Since p(A) = p(W) and W is opened, p(A) must be opened as well. Furthermore, 
y G A and p(y) = 0, so 0 G p{A). But by definition, Pe(HA) = p(A) so Pe(HA) is also 
opened and contains 0. Thus (l28l) will hold provided B is sufficiently small. 

Let £> 0 be as in the statement of Lemma [3] Let B be any opened ball in ]R m centered at 
0 which is small enough so that its closure B is contained in B 0 . Let xi,x 2 ,... ,X{,... be a 
convergent sequence in Ab with limit x*. To establish (l29l) . it is enough to show that x* G A. By 
definition, Ab = -4.np -1 (£>) so x, G Anp^^B), i > 1. Therefore x* G A which is the closure 
of A. Since Xi G p _1 (£>), p(xi) G B. Therefore p(x*) G B so p(x*) G B a . Hence x* G p _1 (H 0 ). 
Thus by Lemma [3] x* G A U C. But x G A and A and 0 are disjoint so x G A. Therefore 
(l29l) is true. ■ 

Proof of Theorem [3): Let B be an open ball centered at 0 which satisfies (l28l) and ([291 ) . Corollary 
U] guarantees that for any // in any sufficiently small open neighborhood A4 about 0, the error 
system has an exponentially stable equilibrium e M . Suppose A4 is any such neighborhood, which 
is also small enough so that for each p G M, e M G B. Since for each p G M, the error system 
has as an exponentially stable equilibrium, for each such p there must be a sufficiently small 
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positive radius r jL for which any trajectory of the error system starting in {e : ||e — e: /( | < r M }, 
lies wholly within B and converges to e )I: exponentially fast. 

Now fix p E M. We claim that for any point e E IR m such that ||e — e M || < r M , there is at 
least one vector q E A for which Pe(Hq) = e. To establish this claim, note first that e E B. In 
view of (l28l) . there must be a vector p E A such that Pe(Hp) = e. Thus q = p has the required 
property. 

Now let q be any state in A such that e(Hq ) is close enough to so that 11 Pe(Hq) -e^ll < V 
Then Pe(Hq) E B so q E Ab■ Let x(t ) be the solution to the overall system starting in state 
q. Then x{0) E Ab- Let |0. T) denote the maximal interval of existence for this solution and 
let T* denote the largest time in this interval such that x(t) E Ab for t E |0. T*). Suppose 
T* < T in which case x(t) is well defined on the closed interval [0, T*]. Moreover, since x(t) is 
continuous and in Ab on [0,T*) it must be true that x(t) E closure^/?), t E [0,T*]. Therefore 
x{t) E A, t E [0,T*] because of (l29l) . In view of Theorem [Q Pe(Hx(t)) = e(t), t E [0,T*] 
where e(t) is the solution to the error system starting at e(0) = e{Hq). But ||e(0) — 
so for t E [0,T*], e(t) E B. Therefore Pe(Hx(t )) E B for t E [0, T*]. It follows that x(t) E 
Ab, t E [0, T*]. This contradicts the hypothesis that T* is the largest time such that x{T*) E Ab 
for t <T*. Therefore T* = T. Clearly Pe(Hx(t)) = e(t) and x{t) E Ab for all t E [0, T ). 

The definition of r fl and the assumption that ||e(0) — e n\\ < r n imply that e(f) must converge 
to exponentially fast. Thus there must be a positive constant c such that ||e(f)|| < c, t > 0. 
Therefore \\Pe(Hx(t))\\ < c, t E [0,T). In view of (fl2l) . \\e(Hx(t))\\ < c where c = ||P'||c + 
||P'|| s up||d|< c 11^(011- Clearly ||e fc (z(t))|| < c, k E m. Therefore ||^(t)|| < \Jc. + d%, k Em 
because of ©. Therefore | \z(t) \ \ must be bounded on [0, T ) by a constant C depending only on c 
and the d k . Since x = —R'(z)e(z) + S'(z)p and R(-) and S(-) are continuous, it must be true that 
||x|| is bounded on [0 ,T) by a finite constant. This implies that ||a:(f)|| < C\ + c 2 T, t E [0, T) 
where c\ and c 2 are constants. From this it follows by a standard argument that T = oc. 
Therefore statement |T| of the theorem is true. Statement [2] is a consequence of (fl2l) and the fact 
that Pe(Hx(t )) = e(t), t > 0. ■ 

The proof of Theorem [3] makes it clear that if the overall system starts out in a state .i;(0) E A 
for which the error e{Hx{ 0)) is sufficiently close to the error system equilibrium output e M , then 
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the trajectory of the overall system lies wholly with As for all time. Repeated use of this fact 
will be made throughout the remainder of this paper. 


IV. Square Subsystem 


In this section we derive a special 2x2 “square” sub-system whose behavior along trajectories 
of the overall system will enable us to easily predict the behavior of x(t). Suppose that during 
some time period [f 0 ,fi), the state x(t) of the overall system is “close” to a state y for which 
(G, y} is a target formation. Since sufficient closeness of x(t) and y would mean that the 
formation in {G, x(t)} is infinitesimally rigid, it is natural to expect that if x(t) and y are close 
enough during the period [£ 0 ,ti), then over this period the behavior of all of the z r will depend 
on only a few of the z*. As we will soon see, this is indeed the case. To explain why this is so, 
we will make use of the fact that the z system in © can also be written as 


Zl z 2 



Z 1 z 2 



M(e(z),n) 


(31) 


where M(e,/i) is a m x m matrix depending linearly on the pair (e,/i). This is a direct 
consequence of the definition of the z t in © and the fact that the x, satisfy ©. We can now 
state the following proposition. 


Proposition 2: Let {G, y} be a target formation. There are integers p,q £ m depending on y 
for which z p (y) and z q (y) are linearly independent. Moreover, for any ball B about zero which 


satisfies (l28l) and (|29|) . the matrix Z(z) = 


Zp Zq 

2 Xra 


is nonsingular on HA& and there is a smooth 


matrix - valued function Q : e(HAjs) —> IR^ xm for which 


Zl Z 2 



Z(z)Q(e(z)), z G HA b - 


(32) 


If x(t) is a solution to the overall system © for which x(t) G Ab on some time interval [t 0 , ti), 
then on the same time interval, Z(Hx(t )) is nonsingular and satisfies 


Z = ZA(e(z), p) 


(33) 


where A(e,p) = Q(e)M(e, p)L and L is the m x 2 matrix whose columns are the pth and qth 
unit vectors in ]R m . Moreover 


Q(^/x)3T(e^, /i) -4(c m , p^Q^z^) 


(34) 
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where c /; is the equilibrium output of the error system. 


The proposition clearly implies that on the time interval [t 0 , h), the behavior of the entire vector 
z is determined by the behavior of the square subsystem defined by (l32l) and (l33l) . The proof of 
Proposition [2] depends on Lemma [5] which we state below. 


In the sequel we write pi A p 2 for the wedge product p\ A p 2 
Pi,p 2 € IR 2 . The wedge product is a bilinear map. 



P2 


of any two vectors 


Lemma 5: Let {G, x} be an infinitesimally rigid formation in IR 2 with multi-point x = 
-| / 


rr* rpf ... r Y‘^ 
*^1 '^2 

common vertex k 


. Then for at least one pair of edges ( i , k ) and (J, k ) in G which share a 

, (xi - x k ) A (xj - x k ) ^ 0. 


A proof of this lemma is given in the appendix. 


Proof of Proposition [2t Since {G, y} is a target formation, it is infinitesimally rigid. In view 
of Lemma [5] and the definition of z, in ([3]), there exist integers p.q G in for which z p A Z q 0 
at x = y. By a simple computation 


( A Z n ) Zn 


{ZZqf 


(35) 


for all x. Suppose that Xi,Xj,x k ,xi are the sub-vectors of x for which z p = Xi — x :j and z q = 
x k — xi. As a consequence of (1351) and Proposition Q] there is a smooth function h : e(HA ) — > IR 
such that ( z p A z q ) 2 = h(e(Hx)), x e A\ moreover h(e(Hy )) ^ 0 because z p (y) A z q (y) ^ 0. 
It follows that z p A z q ^ 0, x G A$. Thus z p A z q ^ 0 for all z e HAb so the matrix 

Z(z) = ' 


Z p Zq 


is nonsingular for all such z. 

To proceed, note that for all z e HAb , the matrix 

P(z) = 

satisfies 

zi z 2 ■■■ z m 


- 

-i 


- 

Zp Zq 


Zi Z 2 • • 

Zm 


Zp Zq 


P(z). 


We claim that for z e HAb, P{z) depends only on e(z); that is P(z) = Q(e(z )) for some 
matrix Q which is a smooth function of e. To establish this claim, note first that P(z) can be 
written at 

P(z) = 


Zp Zq 

~\k 

Zp Zq 

)(K 

Zp Zq 

r 1 - 

Z1 2; 2 . 

Zm 
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where K 


0 

1 


-1 

0 


. By Cramer’s rule 


Zi A (Kz q ) z 2 A(Kz q ) ■■■ z m A(Kz q ) 

(P Zp) A Z\ (P Zp) A z 2 * * * (P Zp ) A z m 

and 

(P Zp) A Zq (K Z q ) A z q 
Zp A (P Zp ) /jp A (K^q) 

But for all i,j G rn, z r A ( Kzj ) = z[zj and (Kz,) A Zj = —z[z.y From this and (|35T) it follows 
that 

-z[z q -z' 2 z q ■ ■ ■ -z' m z q 

ZpZl z' p Z 2 ■ ■ ■ ZpZ m 

Since 1111 2 1111 2 — {z' p z q ) 2 7 ^ 0 ,zE HAb, P{z ) is a smooth function of terms of the form 

z' r z s , r,sE m. 


P(z) = 


(ZpZqY 


ZpZ q 


Z q Z q 


— z'pZp ZpZq 


Z~ l (KZ) = - 

Zp A Z q 


(KZ) 


-1 


zi z 2 


Zp A Zq 


In view of © it is therefore clear that on As, P(Hx ) is a smooth function of inner products 
of the form (xi — Xj)'(x k — x{) for i,j, k,l E n. But Aq C A. From this and Proposition Q] it 
therefore follows that on Ab, P(Hx) = Q(e(Hx )) where on e(HAe), Q(e) is a smooth function 
of e. Thus the claim is established and (1321) is true. Moreover, since x(t) G Ab for t G [£ 0 ,£i), 
z G HAb ° n the same time interval. Therefore Z is nonsingular on [7 : 0 ,1 1 ). 


The definition of L implies that 


Z = 


z 1 2:2 ■ ■ ■ z„ 


L. 


Thus from (l3ll) . 


Z = 


Zi Z 2 ... Zr, 


M(e, n)L. 


This and (1321) imply that (1331) is true. 


(36) 

(37) 


To prove (l34l) . let x(t) be a solution to the overall system in A, along which e(Hx) = e M . 
In view of Theorem [3l such a solution exists. Moreover x(t) G Ab , t > 0. Clearly z(t) G 
HAb, t> 0 so 


z\ z 2 



Z(z)Q(tp), t > 0 


(38) 
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because of (l32l) . We claim that 


ker Q(tfj,) C ker Q(e M )M(e #4 ,//). (39) 

To prove this claim, let p be any vector such that Q{z^)p = 0. Then ZQ(z f ,)p — 0, t > 0 so 

p — 0, t > 0 


because of (1381). Therefore 


Zi Z 2 ... z n 


Zi z 2 ■■■ z v 


p = 0, t > 0 


SO 


Z-l z 2 



p)p = 0, t > 0 


because of (|3TT) . Hence by (l38l) . ZQ(z fl )M(z fl , p)p = 0, t > 0. But Z is nonsingular for t > 0, 
so Q(c A1 )M(e M , p)p = 0. Since p is arbitrary, (l39l) is true. 


In view of (l39l) . there must be a matrix B such that p) = BQ(z fl ) But from (l36l) 

and (l32l) we see that Z = ZQL. Since Z is nonsingular, QL = I 2x2 . Thus Q(c m )M(c m , p)L = 
BQ(t^)L = B, so B = j4(c^, p). ■ 


V. Analysis of the Overall System 

In view of Theorem [3] we now know that for any mismatch error p with small norm and 
any initial state x(0) G A for which e(Hx( 0)) is close to the error system equilibrium output 
c /( , the error signal e(Hx(t )) must converge exponentially fast to and x(t) must be bounded 
on [0, oo). But what about x(t) itself? The aim of the remainder of this paper is to answer this 
question. We will address the question in two steps. First in Section IV-AI we will consider the 
situation when e(Hx(t )) has already converged e M . Then in Section IV-Bl we will elaborate on 
the case when e(Hx(t )) starts out close to e M . 


A. Equilibrium Analysis 

The aim of this section is to determine the behavior of the formation {G. x(t)} over time 
for x(t) 6 A and for mismatch errors from a suitably defined “generic” set, assuming that for 
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each such value of p, the error e(Hx(t )) is constant and equal to the equilibrium output of 
the error system. We will do this by first determining in Section IV-A11 a set of values of p for 
which z and x are nonconstant for all t > 0. Then in Section IV-A2I we will show that for such 
values of p, the distorted but infinitesimally rigid formation {G, x(t)} moves in a circular orbits 
about the origin in IR 2 at a fixed angular speed 


1) Mismatch Errors for which z is Nonconstant: The aim of this sub-section is to show that 
once the error e{Hx{t )) has converged to a constant value, neither z nor x will be constant for 
small ||/i|| other than possibly for certain exceptional values. We shall do this assuming that the 
target formation {G, y} is “unaligned” where by an unaligned formation is meant a formation 

r n / 


{G, x} with multi-point x = 


0C-\ 


x r 


6 IR 2 " which does not contain a set of points 


Xi, Xj, Xk, xi in IR 2 for which the line between x t and Xj is parallel to the line between ay. and ay. 
This is equivalent to saying that {G, x} is unaligned if, for every set of four points x t , x 3 , Xk, xi 
within x, (x, — xf A (xk — x{) f 0. It is clear that the set of multi-points x for which {G, x} 
is unaligned is open and dense in IR 2n . 


Throughout this sub-section we assume that Ab is as in Lemma 0] that A4 is as in Theorem 
[3] and that for each p e N4, x(t,p) is a solution in Ab to the overall system for which 
e(Hx(t,p)) = where is the equilibrium output of the error system e = g(e,p). Our 
ultimate goal is to show that 2 is nonconstant for small normed but otherwise “generic” values 
of fi. The following Proposition enables us to make precise what is meant by a generic value. 


Proposition 3: If the target formation {G, y} is unaligned, there is an open set M. 0 C A4 
about p, = 0 within which the set of values of p for which z(x(t, p)) is nonconstant along an 
overall system solution x(t) in Ab for which e(Hx(t )) = is open and dense in Afo- 


What the proposition is saying is that for almost any value of p within any sufficiently small 
open subset of lR m which contains the origin, z(x(t. //)) will be nonconstant along any trajectory 
of the overall system in A for which e is fixed at the equilibrium output e /( of the error system. 
Thus if p has a sufficiently small norm and otherwise chosen at random, it is almost for certain 
that z(x(t, p)) will be nonconstant. It is natural to say that p is generic, if it is a value in Af 0 
for which z(x(t,p)) is nonconstant. 
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The proof of Proposition [3] relies on a number of ideas. We begin with the following con¬ 
struction which provides a partial characterization of the values of /i for which z is nonconstant. 


Let x = 


Jb 1 ily 2 


• x' be any multi-point at which {G, x} is an infinitesimally rigid 
formation. As is well known, the corresponding rigidity matrix R = R(z)\ z =s x has a kernel 
of dimension three HE We’d like to compute an orthogonal basis for ker R. Towards this end, 
first recall that rank H mxn = n — 1 because G is a connected graph; thus ker H must be a one 
dimensional subspace and because of this ker H must be of dimension two. It is well known and 


easy to verify that the vectors q\ = 


and q 2 = 


0 10 1 


0 1 


1 0 1 0 ••• 10 

constitute an orthogonal basis for ker H. Next recall that R = D'H. This implies that q\ and 
q 2 are in ker R. It is easy to verify that a third linearly independent vector in ker R is q 3 — 


(K Xl y ( Kx 2 y 

To proceed, let 


(Kx n y 


where K = 


0 -1 

1 0 


v avg {x) = 


n 


£ 

i— 1 


Xi 


and define q 0 = q 3 + v 2 q\ — v\q 2 where 


v-i v 2 


= V; 


avg 


[x). Since span {(/o, Qi, Q 2 } and span 


{qi,q 2 , q?,} are clearly equal, the set { q {] . q\ , q 2 } must be a basis for ker /?. By direct calculation, 
q' Q q t = 0, i G {1,2}, which means that {g 0 , qi, ^ 2 } must be an orthogonal set. Therefore 
{?o, 9i, 92 } is an orthogonal basis for ker R. With this basis in hand we can now give an explicit 
necessary and sufficient condition for z(Hx(t, fi)) to equal zero at any value of x along a 
trajectory x(t,fi), t > 0 in A of the overall system at which e(Hx(t, n))\ x (t,n)=x — 0. 

Lemma 6: Let // e !R m be fixed and for k e m, let ( ik,jk ) denote the arc from vertex 4 
to vertex jk which corresponds to edge k in the oriented graph G. Suppose that multi-point 


x = 


•Jb I 0/0 




is a state of the overall system along a trajectory in A at which 

c(Hx(t , /r)) \x(t,[i)=x 0 

Then at this value of x, z(Hx(t, fj))\ x (t !tl )= x = 0 if and only if 

w(x)'fi = 0 (40) 
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where 


w(x) 


(Xh x aV g(x)) A ( Xj i x aV g(x)) 
k - UwgO)) A (x jm - X avg (x)) 


(41) 


The reason why this lemma only partially characterizes the values of /i for which z is nonconstant, 
is because the state x in (140b depends on /i. The proof of this lemma is given in the appendix. 


Triangle Example Continued: Equation (140b simplifies considerably in the case of a triangular 
formation. For such a formation with coordinate vectors X\. x 2 - x 3 , we can always assume 
{without loss of generality} a graph orientation for which x l3 — x\ — x n , x il = x 2 = x j2 
and x i2 = x 3 = x 33 . Under these conditions it is easy to check that for k E {1, 2,3}, 

(x ik - Vavg(x)) A (x jk ~ V avg (x)) = ~^( x 2 — x{) A (x 3 — X 3 ). 

Thus for this example, z(Hx(t))\ x (t)= x = 0 if and only if 


(x 2 - Xi) A (xi - x 3 )(/ii + /i 2 + AI3) = 0 


where 


/ 


/U fJ-2 ^3 


A- 


We now return to the development of ideas needed to prove Proposition [3] 


(42) 


Lemma 7: Let B and As be as in the statement of Lemma HI Let p, q be distinct integers in 
m. There is a continuous function a : B —> 1R for which 


(x p — v(x)) A (x q — v(x)) = a(e(Hx)), x E A® (43) 

where v(x) is any fixed linear combination of the position vectors x t , i E n in x. If, in addition, 
the target formation {G, y} is unaligned, then o(0) ^ 0. Moreover, if B is sufficiently small, 
then a is continuously differentiable. 

A proof of this lemma is given in the appendix. 

Lemma 8: Let S C IR m be an open subset containing the origin. Let / : S —> Hi 1 xrn be a 
continuously differentiable function such that /(0) 7 ^ 0. Then there exists an open neighborhood 
U C S of the origin within which the set of s for which f(s)s 7^ 0 is open and dense in U. 
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A proof of this lemma is given in the appendix. 

Proof of Proposition S Let «;(•) be as in the statement of Lemma [ 6 ] By hypothesis, {G. y} is 
an unaligned formation and x(t, /i) 6 Ab for all t > 0 and all // e M. In view of Lemma [71 for 
B sufficiently small the xth term in the row vector w(x(t, /i)) can be written as a.i(e(Hx(t , /i))) 
where a* :£>—)■ IR is a continuously differentiable function satisfying a t (0) ^ 0. Since this 
is true for all m terms in w, there must be a continuously differentiable function /? : B —* 
IRixm sat j s fyi n g ^(o) ^ 0 for which w(x(t,/i)) = (3(e(Hx(t, /x))), t > 0, /x G M. But 
e(Hx(t,y)) = e M , t > 0, fi E M where c 0 = 0 and /i i—>• is continuously differentiable. 
Thus there is a continuously differentiable function / : M —* Hi 1 xm for which /(0) ^ 0 and 
w(x(t,n)) = t > 0 , fie M. 

Note that e(Hx(t,/i )) = 0 because e(Hx(t,fi)) = c M . Therefore, according to Lemma [ 6 l 
z(Hx(t , /x)) = 0 for some f and fi e M if and only if w(x(t , /x))/i = 0. But w(x(t , /i))/x = f{fi)fi 
for all t > 0. Therefore z(x(f,/x)) is constant for all f > 0 if and only if /(/x)/x = 0. But by 
Lemma [ 8 l there exists a neighborhood Afo C .A/1 of the origin within which the set of /x for 
which /(/x)/x 7 ^ 0 is open and dense in Mo- Thus for any /x in an open dense subset of Mo, 
z(x(t,fi)) is nonconstant on [ 0 , oo) ■ 


2) Equilibrium Solutions: The aim of this section is to discuss the evolution of the formation 
{G, x(t, fi)} along an “equilibrium solution” to the overall system assuming that /x is fixed at 
any value in M. By an equilibrium solution, written x(t), is meant any solution to © in A 
for which e{Hx{t )) = c M , t > 0, where is the equilibrium output of the error system. For 
simplicity we write z(t ) for = z(x(t)) and let i e m, be the sub-vectors in 1R 2 comprising 


z(t); i.e., z(t) = 


z'lif) z' 2 {t) 


Z' n (t) 


Note that since e(Hx(t )) e B, x(t) e Ab and therefore z(t) e HAb , t > 0. Thus, in view 


of Proposition [2l there are integers p,q e m for which the matrix Z (t) = 
nonsingular for t > 0. Moreover 


z p {t) Zq {t ) 


IS 


Zl "2 


= Z(t)Q, t > 0 


(44) 


and 


Z = ZA, t > 0 


(45) 
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where Q and A are the constant matrices 0 = and A = A(z t! , //). It follows that the 

Gramian Z'Z must satisfy 

Z'Z= A 1 Z'Z + Z'Z A. (46) 


In view of the definition of the z x in we see that the four entries in Z'Z are of the form 
(xi(t) — Xj(t))'(xk(t ) — xi(t)) for various values of i, j, k and l. But x(t) G A, t > 0, so as a 
consequence of Proposition Q] each such term is equal to a term of the form 77 ^/(e M ) which is 
constant. Therefore Z'Z is constant on [0,oo). Hence 

At Z'Z + Z'Z A = 0 (47) 

because of (l46l) . Clearly 

(ZAZ- 1 )' + ZAZ- 1 = 0 . 

Evidently the 2x2 matrix ZAZ~ l is skew symmetric so its spectrum must be {jui, —ju:} for 
some real number cj > 0. But A is similar to ZAZ~ 1 so A must have the same spectrum. 


We claim that A = 0 and consequently that cj = 0 if and only if 5 is constant. To understand 
why this is so, note first that if z is constant, then Z — 0. On the other hand, if Z = 0 then z 
must be constant because of (1441) . Meanwhile Z = 0 if and only if A = 0 because of (1451) and 
the fact that Z is nonsingular. Thus the claim is true. 


Suppose z is nonconstant; as noted in Proposition [3] this will be so if /i G Mq. Then one 
has uj > 0 in which case z p and z q (t) must be sinusoidal vectors varying at a single frequency 
uo. Moreover the same must also be true of the remaining z t because of (l44l) . Additionally, each 
Zi must have a constant norm because for all t > 0, ||^(f)|| 2 = ei(Hx(t )) + d 2 , i G m, and 
e(Hx(t )) = e M . These properties imply that z t must be of the form 


z k (t) = (c fc + df.) 2 


COS (ujt + (j>k) 
a k sin(cuf + <p k ) 


where t k is the A th component of e /( and a k equals either 1 or —1. We claim that all of the a k 
must be equal. To understand why this is so, observe that for all i, j G m, 

4(^Aj) _ , j- 1 j2 


dt 


= + df) 2 (tj + dj ) 2 {(JiOj - 1) sin(2a;t + fa + 
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Since each z\z 2 is constant and ufa + d 2 )^(lj + d 2 )^ ^ 0, it must be true that Oi<7j — 1 = 
0, i.j G m. Therefore a., = ay, %. j E rn so all of the have the same value. We are led to 
the following result. 


Proposition 4: Let p G M be fixed and let y be any {G. y} be a target formation. Suppose 
the error system is in equilibrium with output c M . Suppose x is a solution in A to the overall 
system along which e{Hx{t )) = t > 0. Then either each z k {t) is constant with norm squared 
tk + d 2 k or there exist phase angles (p,- k G m, and a frequency co > 0 such that 


Z k (t) = {tk + dfc ) 2 


, k G m 


(48) 


cos{ut + <p k ) 
a sin {ut + (pk) 

where c k is the kth component of the equilibrium output and a is a constant with value 1 or 


- 1 . 


It is worth noting that if o = 1 then all of the z k rotate about the origin in 1R 2 in a clockwise 
direction, while if a = — 1, the Zi all rotate in a counter-clockwise direction. 


We are now in a position to more fully characterize any equilibrium solution x. Two situations 
can occur: Either z{t) is constant or it is not. We first consider the case when z{t ) is constant. 
Examination of © reveals that if z is constant then so is x. This means that the any formation 
{G, x} for which 5 is constant is either stationary or it drifts to off infinity at a constant velocity, 
depending on the value of p e M. If there is no mismatch {ie, p = 0}, then = 0, as noted 
just below Corollary [Q In this case x must therefore be constant and the formation must be 
stationary and have desired shape. The following example illustrates that formations for which 
z is constant, can in fact drift off to infinity for some values of p G M. 

Triangle Example Continued: We claim that under the conditions that 5 is constant and p ^ 0, 
the velocity of the average vector u avg = ^ ( x \ + x 2 + -X's) is a nonzero constant which means that 
with mismatch, the triangular formation (G, x} must drift off to infinity at a constant velocity. To 
understand why this is true, note that the mismatch errors must satisfy the non-generic condition 

Pi + P2 + P3 = 0 (49) 

because of Lemma [6l (l42l) and the hypothesis that 5 is constant. Meanwhile from ® , u avg = 
z\pi + Z2P2 + -3 /As, so if i) avg were zero, then z\p\ + z 2 p‘> + z 3 p 3 = 0. But for the triangle, 
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Z\ + z 2 + z 3 = 0 which means that z,\ (/i 1 — / /;>) + 2:2 (^2 — / 13 ) = 0. However 7 and z 2 are linearly 
independent because the formation {G, x} is infinitesimally rigid. Therefore the coefficients 
/ii — /i 3 and /i 2 — /i 3 must both be zero which means that Hi = /U 2 = /i 3 . This and (1491) imply 
that /i = 0 which contradicts the hypothesis that //. ^ 0. Thus for the triangular formation, i) avg 
is a nonzero constant as claimed. 


We now turn next to the case when z is nonconstant. In view of Proposition [3] this case 
is anything but vacuous. We already know that in this case, oj > 0. In view of ©, and the 
assumption that e(Hx(t )) = e M , it is clear that the x t satisfy the differential equations 


%i = ~ Zk v tk » + zL z kiMkij + Vkij), i e n. (50) 

jeM+ jeAfr 

Note that the right hand sides of these differential equations are sinusoidal signals at frequency 
u because the e, and ji, are constants. This means that the x % must be of the form 


Xi(t) = 


+ qi, i e n 


di cos (a jt + 9i) 
abi sin (cut + 7^ 

where the q t are constant vectors in 1 R 2 and the a*, bi, and 0, are real numbers with Oi > 0 . 
Note, in addition, from (l50l) that for each i, ||xj || 2 can be written as a linear combination of 


terms of the form for various values of j and k. But in view of © and Proposition [I] each 
such term 5 '27 is a function of e(Hx(t )) which in turn equals which is a constant. Thus each 
norm ||xj|| must be a finite constant. This means that 7, = 9 t , bi = a* and thus that each Xi is 


O'i 


+ qi, i e n. 


(51) 


of the form 

cos(c ot + 6i 
crsin(o;f + 9i) 

We claim that all of the q, are equal to each other. That is, there is a single vector q for which 

cos(c ot + 9i) 
a sin (ut + 9i) 

implies that z k = u>Kz k , 1 <E n, where 


Xi(t) = a t 


+ q, i E n. 


(52) 


To understand why this is so, note first that 
0 -1 


K = 


0 


. Suppose that x, and x 3 are the coordinate vectors for which z k = x* — x r Then 

Xj = uK(xi — Xj). (53) 


Xi 
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But from (I5TT) . 


Xi = u)K(xi - qi), ie n 


so 

Xi — Xj = l oK(xi — Xj)) + ojK(qi — qj). 

From this and (l53l) it follows that u>K(qi — qj) = 0 and thus that q, = qj. Since this argument 
applies to all edges in a connected graph G, it must be true that all q % are equal as claimed. We 
are led to the following characterization of equilibrium solutions. 

Theorem 4: Let /i 6 M be fixed and suppose that {G, y} is a target formation. Let x be a 
solution in A to the overall system along which e(Hx(t )) = e M . 

1) If /i is a mismatch error for which z is constant, then depending on the value of /i, all 
points within the time-varying, infinitesimally rigid formation {G, x(t)} with distorted 
edge distances (e,; + d'f)T i £ m, are either fixed in position or move off to infinity at the 
same constant velocity. 

2) If yU is a mismatch error for which z is nonconstant, then all points within {G, x(t)} rotate 
in either a clockwise or counterclockwise direction with the same constant angular speed 
u > 0 along circles centered at some point q in the plane, as does the distorted formation 
itself. Moreover if the target formation {G, y} is unaligned, almost any mismatch error // 
will cause this behavior to occur provided the norm of y is sufficiently small. 


B. Non-Equilibrium Analysis 

Fix y G Ai. In this section we will consider the situation when a solution x(t) of the overall 
system starts out with an error signal e(Hx(t)) which is initially close to the equilibrium output 
of the error system. As in section IV-A21 we let x(t) denote an equilibrium solution of the over 
all system and we write z(t ) = z(Hx(t)). There may of course be many equilibrium solutions 
x(t) to the overall system along which e = e /( . Our aim is to show that any solution to the 
overall system starting with e(Hx{ 0)) sufficiently close to e /( converges exponentially fast to 
such an equilibrium solution. 
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Let e = g(e, /i) be the error system and let A C X be an ambient space on which it is valid. 
Let B be any ball satisfying the hypotheses of Lemma [4j We know already from Theorem [3] 
that with \ \e(Hx(0) — e M || sufficiently small with x(0) G A, x(t) exists and is in Ab for all time 
and e(Hx(t )) converges exponentially fast to e M . We assume that \\e(Hx(0) — e^|| is this small. 
We also know from Proposition [2] that there are integers p.q G m and time-varying matrices 
Q(e(Hx(t ))) and A(e(IIx(t)), //), henceforth denoted by Q(t) and A(t) respectively, for which 


zi z 2 



(54) 


and 


Z = ZA 


(55) 


where G IR 2 is the /th component sub-vector of z = Hx(t ) and Z is the nonsingular, time- 


varying matrix Z = 


Zp Zq 


. Since e(Hx(t )) converges to c /; exponentially fast, Q and A 


converge exponentially fast to constant matrices Q = <5(c M ) and A = ^(c^/i) respectively. 


Note that because of ©, 


\Zi\ 


= dj + e i: i G m, where e* is the zth component of e(Hx(t)). 


Thus for i G m, 


converges to d 2 + e ( where c, is the /th component of c,,. Therefore the 


and Z must be bounded on [0, oo). Note in addition that e At must be periodic and consequently 
bounded on the whole real line (— oo, oo) because either A = 0, or if it is not, its spectrum must 
be { joj , —jco} for some co > 0. 


Let V 2X 2 be that solution to V — VA with initial state 

POO 

1 /(0) = Z( 0) + / U(r)e~ Ar dT (56) 

Jo 

where U = Z(A — A). Note that U tends to zero exponentially fast because Z is bounded 
and because A — A tends to zero exponentially fast. Observe that V (0) exists because e~ At is 
bounded on [0, oo) and because U tends to zero exponentially fast. Note that V must be periodic 
because e At is. We claim that Z converges exponentially fast to L as t -x oo. To understand 
why this is so, consider the error E = Z — V and note that 

E = EA + U. 


By the variation of constants formula 

E{t) = E{0)e At + [ U(r)e A{t - T] dr. 
Jo 
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In view of (1561) . 


m 


U{r)e A ^- T) dr. 


J t 

Now since e AI ' l ^ T) is bounded for all t and r and U(r) tends to zero exponentially fast, there 
must exist positive constants c and A such that \\U(r)e A< ' t ~ r \\ < ce~ Xr . Clearly ||£'(f)|| < 
f t °° ce~ Xr dr = j-e~ xt so E{t) —)■ 0 as t —> oo as fast as e~ xt does. It follows that Z converges 
exponentially fast to V as claimed. 


Let v p and v q denote the columns of V and for all i E m except for i E {p. q}, define 
Vi = VQQ where Q is the 7th unit vector in IR m . We claim that for i E in, z r converges to v t 
exponentially fast. To understand why this is so, note that because of Q 's its definition in the 
proof of Proposition [2l QQ„ = l/ \ and Q( q = v 2 where ;/* is the /th unit vector in 1R 2 . Since Q 
converges to Q, Q( p = and Q( q = u 2 . From this it follows that v p = VQ( p , v q = VQ( q , and 
thus that Vi = VQQ, i E m. Hence, for each z e m, z % — v t = ZQQ — VQQ. Therefore for 
each such i, Zi~V{ = ( Z(Q — Q) + (Z — V)Q)Q. But Z and V are bounded signals and Z —y V 
and Q —> Q so clearly for i E m, Zi converges to v t exponentially fast as claimed. 


We now claim that 

IKWII 2 = C + t > 0, i E m (57) 

where, as before, e, is the zth component of c p . To understand why this is so, recall that | z t \ \ 2 = 
ei(Hx(t )) + dj because of ©. Moreover eQHx^t)) converges exponentially fast to Q. Thus 
||^i|| 2 converges to Q + dQ We know that ||zi|| 2 converges to ||fj|| 2 because Zi converges to zy. 
Therefore | v t \ \ 2 converges to c, + d‘f. But each v, is a sinusoidally varying vector at frequency 
u because V is a solution to V — VA. This means that each norm ||ujj[ 2 is periodic. Thus the 
only way |uj| | 2 can converge is if it is constant to begin with. Therefore ||uj(f)|| 2 = c* + dj for 
all t > 0 as claimed. 


To conclude we need to construct an equilibrium solution x(t) to the overall system to which 
x converges. As a first step let us note that the differential equation describing the overall system 
([8]) can be written as x = B(e(z),p)z where B(e,p) is continuous in e and z = Hx. Define 

/*oo nt 

x(t) = x(0) + / w{r)dr + / 5(e M , p)v{r)dT 

Jo Jo 
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where w(t) = B(e(Hx(r)), pt)z(r) — B(z fl , /x)u(r) and v = 


v\ Vn 


. The integral 


/ 0 °° w(r)dr is well defined and finite because z — v and B(e(Hx(t)), /i) — B(z fJi , p) tend to zero 
exponentially fast. Our goals are to show that x — x converges to zero exponentially fast and 
also that x(t) is an equilibrium solution to the overall system along which e(Hx(t )) = c M . To 
deal with the first issue observe because of its definition, 


x = B(c fJi ,p)v. (58) 

Thus the error vector q = x — x satisfies q = w(t). Therefore q(t) = x(0) — x(0) + f*w(r)dr 
so q = — f°° w{r)dr. Recall that w converges to zero exponentially fast; therefore by the same 
reasoning which was used to show that E(t) converges to zero exponentially fast, one concludes 
that q must converge to zero exponentially fast. Thus x converges to x exponentially fast. 


It remains to be shown that x is an equilibrium solution. As a first step towards this end, 


note that e(v) = e„ because of 


VQQ, i G m. But V = VA. Thus 


. Next note that 


Vi v 2 


Vi V 2 


= VQ because = 


= VAQ. From this and (l34l) it follows 


that 


Vi v 2 


Vi v 2 


Since e(v) = e^, v must therefore satisfy 
®. But ® can also be written as z = HB(e(z), fi)z, so v — HB(e(v), /x)v or v = HB(z^, fi)v. 
Clearly Hx = HB{z ll ,fi)v because of (l58l) . Hence Hx = v so v = Hx + p for some constant 
vector p. 


We claim that p = 0 and thus that v = Hx. To understand why this is so, recall that each 
Zi — Vi , i E m converges to zero, so v converges to z. We have also shown that x — x converges 
to zero, so Hx must converge to z which equals IIx. Therefore v — Hx must converge to zero 
and the only why this can happen is if p = 0. Therefore v = Hx. If follows from this and (1581) 
that x = B(e(Hx), p)Hx. Therefore x satisfies ® with e(Hx ) = c M , so x is an equilibrium 
solution of the overall system. We are led to the following theorem which is the main result of 
this paper. 


Theorem 5: Let /i 6 Af be fixed. Let x(t) be any solution of the overall system starting 
in a state in A for which the reduced error Pe(Hx(0)) is in the domain of attraction of the 
exponentially stable equilibrium state e: /( of the error system e = g(e, //). There exists a solution 
x to the overall system along which e(Hx(t ) = e M , to which x(t) converges exponentially fast. 
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1) If (i is a mismatch error for which z is constant, then depending on the value of /i, all 
points within the time-varying, infinitesimally rigid formation {G, x(t)} either converge 
exponentially fast to constant values or drift off to infinity. 

2) If n is a mismatch error for which 5 is nonconstant, then all points within {G, x(t)} 
converge exponentially fast to the points in a formation which rotates in either a clockwise 
or counterclockwise direction at a constant angular speed u> > 0 along a circle centered 
at some fixed point in the plane. Moreover if the target formation {G, y} is unaligned, 
almost any mismatch error y will cause this behavior to occur provided the norm of // is 
sufficiently small. 


VI. Concluding Remarks 

In this paper we have identified a basic robustness problem with the type of formation control 
proposed in [j6]|. A natural question to ask is if the problematic behavior can be eliminated by 
modifying the control laws? Simulations suggest that introducing delays or dead zones will not 
help. On the other hand, progress has been made to achieve robustness by introducing controls 
which estimate the mismatch error and take appropriate corrective action similar in spirit to what 
is typically done in adaptive control l(T8l . While results exploiting this idea are limited in scope 
Ifl9l . Il20l . they do nonetheless suggest that the approach may indeed resolve the problem. 

We see no roadblocks to extending the findings of this paper to three dimensional formations. 
All of the material in Sections HD through [TV] is readily generalizable without any surprising 
changes, although the square subsystem in Section |IV] will of course have to be 3 x 3 rather 
than 2x2. This change in size has an important consequence. This implication is that the skew 
symmetric matrix ZAZ~ l used in Section IV-A2 1 to characterize the spectrum of A, will be 3 x 3 
rather than 2x2. Thus in the three dimensional case, if ZA2~ l is nonzero, its spectrum and 
consequently A’s, must contain an a eigenvalue at 0 in addition to a pair of imaginary numbers 
juo and — juj. Thus the corresponding formation will not only rotate at an angular speed ui, but 
it will also drift linearly with time. More precisely, in the three dimensional case, a mismatch 
errors can cause formation to move off to infinity along a helical trajectory. These observations 
will be fully justified in a forthcoming paper devoted to the three dimensional version of the 
problem. 
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Other questions remain. For example, it is natural to wonder how these findings might change 
for formations with more realistic dynamic agent models. We conjecture that more elaborate 
agent models will not significantly alter the findings of this paper, although actually proving this 
will likely be challenging, especially in the realistic case when the parameters in the models of 
different agents are not identical. 

Another issue to be resolved is whether or not a formation needs to be unaligned for the last 
statement of Theorem [5] to hold. We conjecture that the assumption is actually not necessary. 

Finally we point out that robustness issues raised here have broader implications extending 
well beyond formation maintenance to the entire field of distributed optimization and control. 
In particular, this research illustrates that when assessing the efficacy of a particular distributed 
algorithm, one must consider the consequences of distinct agents having slightly different un¬ 
derstandings of what the values of shared data between them is suppose to be. For without 
the protection of exponential stability, it is likely that such discrepancies will cause significant 
misbehavior to occur. 


VII. Appendix 

Proof of Lemma |5fc Suppose that the conclusion of the lemma is false in which case, for each 
k G n, the vectors X; — % G A 4, span a subspace of dimensional at most one. Since G is 

connected, this means that the set of all vectors x* — x 3 for which (i,j) is an edge in G, must 
also span a subspace of dimensional of at most one, as must the set of all i G m. Thus there 
must be a vector w G 1R 2 and nn real numbers c % , i G m such that a, = dw, i G m. Therefore 
D(z) = C®w where D(z) = diagonal {z\, z 2 , ... , z m }2mxm and C = diagonal {ci, c 2 ,..., c m }. 
Then the rigidity matrix for {G, x} is R(z)\ z= g x where R(z) = D'(z)(H 0 J 2x 2 ) and H' is the 
incidence matrix of G. Therefore 

R={C® w)'(H 0 J 2x2 ) = (C" ® w'){H 0 J 2x2 ) = (C'H) 0 w'. 

Thus rank R = (rank C'H) (rank w') < rank C'H ; therefore rank R < rank H. But rank H = 
n — 1 because H' is the incidence matrix of an n vertex connected graph. Therefore rank R < 
n — 1. Since n > 3, this contradicts to the requirement that rank R = 2n — 3 which is a 
consequence of the hypothesis that {G, x} is infinitesimally rigid. ■ 
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Proof of Lemma [6^ It will first be shown that i = 0 if and only if 

q'oS'fi = 0 . (59) 

To prove that this is so, let U and V be full rank matrices such that R = UV. Thus U and V 
have linearly independent columns. This implies that ker V = ker R and that the matrix VV' is 
nonsingular. Since e = e(Hx) is constant, (flOl) implies that RR'e = RS'/j,; thus UVV'U'e = 
UVS'/x. Therefore 

U'e = (VV'yWS’fi. (60) 


In view of ©, the condition i = 0 is equivalent to iHR'e — S' n) = 0 which can be re-written 
as H(V'U'e — S'ji) = 0. This and (l60l) enable us to write 

HP S'ii = 0 (61) 

where 

P = V'iVV'^V - I. 

Note that P is the orthogonal projection on the orthogonal complement of the column span of 
V which is the same as ker V. Since ker V = ker R, P is therefore the orthogonal projection on 
ker R. 


Since !R 2n = ker R(B (ker R) ± , the vector S'n can be written as S'/i = X 0 q 0 + X\qi + X 2 q 2 + 94 
where the A* are scalars and i / 4 is in the orthogonal complement of ker R. Thus /AS"// = A 0 9 o + 
A 191 + A 2 i/y- Therefore II PS'(i = X 0 Hq 0 because q\ and q 2 are in ker II. Therefore (f6Tb is 
equivalent to X 0 Hq 0 = 0; but Hq 0 ^ 0 because q 0 is orthogonal to qi and q 2 and ker II = span 
{ 91 , 92 }- Therefore A 0 = 0 or equivalently, S' /i must be orthogonal to q 0 . Therefore i = 0 and 
(l59l) are equivalent statements. 


Note that q 0 can be rewritten as 


9o = 


K(x± 


av g 


») 


K(yX n ^avg(^)) 

Note in addition that for k G m, row vector x' ik — x', Jk must appear in the kth row and 4th 
block column of S and all other terms in row k of S must be zero. Thus the /. th row of the 
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vector Sq 0 must be (x ik — Xj k )'K(x ik — v avg (x)). This in turn can be written more concisely as 
— (x ik — i’avg(-X')) A (xj k — v aV g (x)). It follows from this and the equivalence of z = 0 and (l59l) 
that the lemma is true. ■ 


Proof of Lemma S Since a wedge product is a bilinear map and v(x) is a linear combination 
of the position vectors Xi, i G n, the wedge product (x p — v(x)) A (x q — v(x)) can be expanded 
and written as a linear combination of the wedge products (x p — x 2 ) A (x q — Xj), i,j G n. That 
is 

(x p - v(x)) A (x q - v(x)) = K(( X P ~ X i ) A ( X q ~ X j ))> (62) 

i,j Gn 

where each \ t] e 1R and x e A&- But A& C A. Therefore, as a consequence of Proposition [0 
there are smooth functions f t j : e(//A) —>■ 1R such that 

(x p - x^ A (xq - xj) 2 = fij(e(Hx)), x e A B , i,j e n. (63) 

Thus the function a : B —* IR, e i—» . gn ^ijy/Jijie) satisfies (l43l) and is continuous. 

Now suppose that (G, y} is unaligned. Then (y p — y 2 ) A (y q — yj) ^ 0, i, j G n. Since y G As, 
(1631) holds with x — y. Moreover, e(Hy) = 0. Therefore 

fij( 0)^0, ij' Gn. (64) 

Hence a(0) ^ 0. 

From (l64l) it is clear that if B is small enough, f 2 j(e) ^ 0, e G i,j G n. Under this 
condition, the functions e i —> a/ fij(e), i,j G n are all continuously differentiable and so 
therefore is a. ■ 


Proof of Lemma [8t The function h : S —> IR defined by s i —> /(s)s is continuously 
differentiable and h( 0) = 0. Moreover, 


dh(s) 

ds 


df(s) 

ds 


s + f(s) 


SO 


dh(s) 


ds 


s=0 


/( 0 ) ^ 0 . 


(65) 


This and the fact that h is continuously differentiable imply that exists a neighborhood U of the 
origin on which 4U-1 i s non-zero. Since is a nonzero, 1 x rn matrix, it is therefore of full 
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rank on U. Therefore every s EU is a regular point of h(s). Hence 0 is a regular value of h(s) 
on hi. Therefore by the regular value theorem ifTOl . the set 

T = {s : s Ehi, h(s ) = 0} 

is a regular submanifold of U of dimension nn — 1. Hence, there exists a neighborhood V C M m_1 
of the origin and a continuously differentiable function <p : V —>■ S such that (p(V) = T. By 
Sard’s theorem, which states that the image of 4> has Lebesgue measure zero in R m , we conclude 
that T is of measure zero and thus its complement is dense in hi . ■ 
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